void selftest_led() {
   
  digitalWrite(debug_led, HIGH);
//  delay(400);

  digitalWrite(arm_led, HIGH);
  delay(200);
  digitalWrite(arm_led, LOW);

  digitalWrite(gps_led, HIGH);
  delay(200);
  digitalWrite(gps_led, LOW);

  digitalWrite(front_led, HIGH);
  delay(200);
  digitalWrite(front_led, LOW);

  digitalWrite(rear_led, HIGH);
  delay(200);
  digitalWrite(rear_led, LOW);

  digitalWrite(debug_led, LOW);

}

void selftest_buz() {
  digitalWrite(debug_led, HIGH);
  digitalWrite(buzzer, HIGH);
  delay(400);
  digitalWrite(buzzer, LOW);
  delay(100);           
  digitalWrite(buzzer, HIGH);
  delay(200);
  digitalWrite(buzzer, LOW);
  delay(100);           
  digitalWrite(buzzer, HIGH);
  delay(200);
  digitalWrite(buzzer, LOW);
  digitalWrite(debug_led, LOW);
}

